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CLAIMS 

1. A control apparatus of a robot comprising: 

a plurality of shafts interfering with each other; 

each of the shafts including a motor, an arm coupled to 
the motor via a spring element such as a speed reducer and a 
motor position detector for detecting a position of the motor; 

a position control unit and a speed control unit in order 
to operate each of the shafts in correspondence with an 
instruction for each of the plural shafts; 

an interference force calculating unit for calculating 
interference force which is exerted to another shaft from an 
instruction of the own shaft; 

a non-interference torque signal forming unit for forming 
a motor torque instruction signal by which the own shaft is 
operated in correspondence with the instruction also in such 
a case that interference force exerted from another shaft is 
present based upon the calculation value of the interference 
force exerted from another shaft, and the instruction of the 
own shaft; and 

a non-interference position signal producing unit for 
producing a motor position signal by which the own shaft is 
operated in correspondence with the instruction also in such 
a case that interference force executed from another shaft is 
present based upon the calculation value of the interference 
force exerted from another shaft, and the instruction of the 
own shaft. 
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2 . The robot control apparatus as claimed in claim 1, wherein 
with respect to interference in the case that the shafts 

are two shafts, 

interference force in the interference force calculating 

unit is calculated based upon the below-mentioned formulae: 
d isl =B * x refl * s 2 

d is2 = A * x ref2 * s 2 

a non-interference torque signal in the non-interference 
torque signal producing unit is calculated based upon the 
below-mentioned formulae : 

t re f.ffl= (J.l* Jli/K1* S 4 + (J b1 +J l1 ) S 2 ) *X refl 

- ( J nl /Kl* s 2 + 1) * d is2 

tref_ff2= ( Jm2* J L2 /K2* S 4 + (j n2 +J L2 ) S 2 ) * X ref2 

- ( Jm 2 /K2* sH 1) *d is i; and 

the non-interference position signal in the 
non-interference position signal producing unit is calculated 
based upon the below-mentioned formulae: 

x re f.m= (J L1 /Kl*s 2 +1) *x refl -l/Kl*d is2 

X re f_ff2= ( JL2/K2* S 2+ 1 ) * X re f2- 1/K2* d isl } 

in the above-explained formulae, the respective symbols 
are defined as follows: 

J m i : first shaft motor inertia moment 

J Li : first shaft arm inertia moment 

Kl : spring constant of first shaft speed reducer 

J m2 : second shaft motor inertia moment 

J L 2 : second shaft arm inertia moment 
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K2 : spring constant of second shaft speed reducer 
A(=B) : coefficients calculated based upon, structures 
of two shafts, angle between two shafts, and geometrical 
relationship between two shafts 
s : Laplace operator 

disi : interference force exerted from first shaft to second 
shaft 

d is2 : interference force exerted from second shaft to 
first shaft 

x re fi : first shaft position instruction 
x re f2 : second shaft position instruction. 

3 . The robot control apparatus as claimed in claim 1 , wherein 
in the case that the shafts exceed two shafts, the 
calculation value of the interference force exerted from another 
shaft, which is used in the process operations by the 
non-interference torque signal producing unit and the 
non-interference position signal producing unit, is equal to 
a summation of interference force calculation values which are 
exerted from the respective shafts to the own shaft. 




